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* NOTICES * 

JPO and INPIT are not responsible for any 
damages caused by the use of this translation. 

1 .This document has been translated by computer. So the translation may not reflect the original 
precisely. 

2.**** shows the word which can not be translated. 
3. In the drawings, any words are not translated. 



DETAILED DESCRIPTION 

[Detailed Description of the Invention] 
[0001] 

[Field of the lnvention]This invention relates to the instruction preparation method which lessens 
delay of a servo, and degradation of the accuracy by vibration extremely in the control method of the 
positioning control system of an industrial robot, a machine tool, etc. 
[0002] 

[Description of the Prior Art]When positioning control of an industrial robot or a machine tool was 
performed, section accelerating with a positive certain acceleration value and acceleration had 
usually given the speed command of the trapezoidal shape constituted from the section of the 
constant speed of 0, and section decelerating with a negative certain acceleration value to the control 
device. In the positioning operation of a short distance like short pitch work, it becomes a speed 
command of the shape of a triangle which does not have the constant speed section as shown in 
drawing 5. Thus, in the response to such instructions, although the waveform of the acceleration 
commands at the time of expressing the acceleration and deceleration of speed with a primary 
function serves as rectangular wave shape, as shown in dr awing 6 , flattery delay arises. The flattery 
delay in a response causes an orbital gap of a load-axis tip, as shown in drawing 7 . 
[0003]ln [ in order to reduce response flattery delay, as it is shown in dr awing 10 ] the feedforward 
control section 15, Although feed-forward control which adds what multiplied by the gain the 
feedforward speed command which differentiated the first degree of the position instruction, and the 
feedforward acceleration commands differentiated the second degree is performed, there is a 
problem that it is accompanied by overshooting as shown in drawing 8 in the response in this case. 
This overshooting is set to one of the causes of vibration produced at the load-axis tip as shown in 
drawing 9 . There is a method of inputting instructions into a low pass filter, or asking for a moving 
average as a device for decreasing vibration of the load-axis tip in a vehicle zone. However, in the 
method which used the low pass filter and the moving average after such acceleration-and- 
deceleration processing, there is a problem that the flattery delay at the tip of a load axis arises by the 



http://www4.ipdl. inpit.go.ip/cgi-bin/tran_web_cgi_eiie?atw_u=http%3A%2F%2Fwww4.ipdl.inpit... 1/22/2010 



JP,10-149210,A [DETAILED DESCRIPTION] 



Page 2 of 6 



response delay of a lagged effect with a filter or a servo system. 

[0004]ln drawing 10 , 1 1 a position control part and 12 a speed control part and 13 A motor section, 14 
is a mechanism part, 15 is a feedforward control section, and K p A position loop gain, A speed 

feedforward gain and K gf K yf An acceleration feedforward gain, K y -- a speed loop gain and J m -- the 

moment of inertia of a motor, and K t -- as for load side moment of inertia and D , a moderating ratio 
t m 

and K c are [ an integration gain and N / the load rate of reduction gears, and J! / reduction-gears 
coefficient of viscosity and D of motor coefficient of viscosity and D ] load side coefficient of 



and thetaj of the angular rate of rotation of a motor and theta § ] the angles of rotation of load. Thus, 

when acceleration commands are expressed with a square wave, the vibration suppression and 
response flattery nature at the tip of a load axis serve as a conflicting requirement. In order to solve 



function of a controlled object which was indicated by JP,5-143106,A is proposed. 
[0005] 

[Problem(s) to be Solved by the lnvention]However, in the method indicated by above-mentioned 
JP, 5-1431 06,A, When the degree of reference positional function theta |ref is set up lower than the 

degree of the numerator polynomial showing the relation of position instruction tneta mrefr of a contro | 

, .... . of an inverse transfer function, In order that the function from which the value 
system / from output tneta. ] 



position instruction, and its differential coefficient, it becomes impossible to compute position 



polynomial of the transfer function of the whole control system, Since a step function is included in 



exists, There is a problem of being easy to produce vibration of a load-axis tip in a rigid low controlled 
object like an industrial robot. Then, also in the positioning control system of rigid low controlled 
objects, such as an industrial robot, there is the issue which this invention tends to solve in providing 
the instruction preparation method of the positioning control system which controls vibration produced 
at the tip of a load axis while canceling the flattery delay at the tip of a load axis. 
[0006] 
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[Means for Solving the Problem]ln an instruction preparation method of a positioning control system 
which this invention interpolates a position in the next teaching point from a certain taught point, and 
creates position instruction theta mref for every control cycle of a servo motor of each axis in order to 

solve an aforementioned problem, When a denominator polynomial showing a relation to position 

instruction theta „ , t , , ., t tt . , . of an inverse transfer function is a constant, In 
mref[ of a control system / from output thet^ ] 

order to compute position instruction theta mref reference positional function theta |ref at the tip of a load 

axis of each axis and whose output theta! of a control system correspond, In an instruction generation 

part, at least primary is higher order than a degree of a numerator polynomial of said inverse transfer 
function in reference positional function theta (ref , and it sets up so that said reference positional 

function theta |ref which constitutes position instruction theta mref , and its differential coefficient may not 

have an absolute term. When a denominator polynomial of an inverse transfer function is the primary 
more than polynomial, in order to compute position instruction theta mref reference positional function 

theta |ref at the tip of a load axis of each axis and whose output theta! of a control system correspond, 
In an instruction generation part, the 1st [ at least ] order sets up said reference positional function 
theta !ref high order from a degree of a numerator polynomial of an inverse transfer function, and a 

filter of a transfer function equivalent to a denominator polynomial of an inverse transfer function is 
formed. By doing in this way, position instruction theta mref reference positional function theta^ and 

whose output theta| of a control system correspond is computable. 

[0007] 

[Embodiment of the lnvention]lt explains referring to the position control system which shows drawing 
1 the example of this invention hereafter. As for a position control part and 3, in drawing 1,1 is [ a 
motor section and 5 ] mechanism parts a speed control part and 4 an instruction generation part and 
2. As for K p , a speed loop gain and J m a position loop gain and K y The moment of inertia of a motor, 

K t ~ as for load side moment of inertia and D m> a moderating ratio and K c are [ an integration gain 

and N / the load rate of reduction gears, and Jj / reduction-gears coefficient of viscosity and D| of 

motor coefficient of viscosity and D c ] load side coefficient of viscosity. As for the angle of rotation of a 

motor, and theta' , a position instruction and u t are [ theta r / acceleration commands and 
m ref mref 

theta m / the angle of torsion between a motor shaft and load and thetaj of the angular rate of rotation 

of a motor and theta g ] the angles of rotation of load. In the instruction generation part 1, position 

instruction theta , adds [ coefficient a_, a., a_, a_, a., and / a c . , ., , , , , 

mref 0 1 2 3 4 5 ] to each from reference angle-of-rotation 

theta |ref of load to the fifth floor differential value of the, applying them, and is generated by them through the filter 6. 
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[0008]Control input u to the controlled object in d rawing 1 becomes like several 1 . 



[Equation 1] 



At this time, in the control system of drawing 1, position instruction theta mref with which reference positional function 

theta |ref of control-output theta ( corresponds can be computed from drawing 1 and several 1, and can be expressed with 

an inverse transfer function like several 2. 
[Equation 2] 



a x = N 2 KvJm(KiKc + KpKi(Dc + Dl) + KpKc) 

a 2 =N 2 Kv{KUm( Dc+Dl) + KpKUmJl + JmKc + KpJmKc(Dc + Dl))+N 7 DmKc + KcDl 

a 3 = W 3 (KvKiJmJl + JmKc + Dm(Dc + Dl) + KvJm(Dc + Dl) + KpKvJmJl) + KcDcJmDl 

a, = N 2 {KvJmJt+JlDm+Jm(Dc+Dl)) + JWc 

a s = N^JmJt 

b a = NKpKvKUmKc 

6, =NKpKvJm(Kc + KiDc) 

b 2 =* NKpKvJmDc 

In order to generate position instruction theta mrgf in the control system of drawing 1 from several two, since the degree of 

the numerator polynomial of an inverse transfer function is the 5th order, reference positional function theta |ref is set more 

than as the 6th polynomial, and the secondary filter 6 equivalent to several 2 denominator polynomial is set up. 
[0009]Here, a case where there is no time of constant speed like short pitch operation is mentioned as an example. When 
acceleration function theta" |ref expressed with drawing 2 and eight following formulas like several 3 is considered, 

reference positional function theta |ref becomes like several 5 in a differential coefficient of reference positional function 

theta. , of several 4 others. 
Iref 

[Equation 3] 

^rW 30 *' 4 ^- 719 ) 4 0<t<To 




are/ 



e;: ef (t)=-a-{t- To) 4 . (t-2io) A 



To<f <27b 



[Equation 4] 
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0 M-cf ^"^'" M f - 7o ) g 3-7b 2 -(/-r 0 )' i6-7b-fr-?b) T 8.r 0 4 -(*-7b) 6 

'" /U a \ 90 9 + 7 21 + 15 



[Equation 5] 



«,W — -l>-»-ft)' t M - ft '^- B '>' - "■»*-»)' -ft-l*)' ] 
To < t £ 2To 

6^(t) = a (S t 1 -56-To-l' + 144-7V-/'-160-7V r 4 + 64 To 4 / 3 ) 0<t<To 
3& (0 ^ ff ' ( 8 - (' - ?"o)' • ^ ' (' - To)' + 144 • To*- (t - To)' - 160-iV (t - To)' + 64 TV (f-fo)') 
To<t£2To 

0 (4 V(O = «'(S6r 6 -336ToV+72OT o 2 -/ 4 -64OTo 3 V+^TV-r 2 ) 0<t<To 
^ 4, w(/)=a-[56(f-7b) S -336-7o.(f-ro) 5 +720-7'o 2 .(r-.7'fl) 4 -640.7b 5 .(r - To)* + 192 To" (f - To) 1 } 
To < t £ 2To 

0 ( V(O = a-( 336fJ ~ 168O :rcw4 + 2880-7V. f J -1920-7V ? 2 +384-7V 0<t<To 

0< 5 V (f ) = a ■ (33 6(* - To) 5 - 1 680 ■ To ■ (t - To)' + 2880 • To 1 ■ (t - Tof - 1 920 • To 1 • (r - To) 1 + 384 • To 1 ■ (r - 7t>)) 



[0010]Position instruction theta mref is computed by substituting each of these elements for several 2, and position output 

thetaj when this theta mref is inputted into the positioning control system shown in drawing 1 is shown in drawing 4 . 

Position output thet^ when position output theta ( when position position instruction theta mref corresponding to the speed 

command of the shape of a conventional chopping sea as shown in drawing 5 for comparison was inputted into the 
control system of drawing 1 is inputted into drawing 7 at the control system using the feed-forward control shown in 
drawing 10 is shown in drawing 9. A time lag becomes it is few and possible [ obtaining the response by which vibration 
was also pressed down ] by this invention so that drawing 4 , drawing 7, and drawing 9 may show. Since there are few 
gaps with a position instruction response and a desired position locus, when performing position control by a multiple 
spindle, the accuracy of an industrial robot, a machine tool of the locus by the side of a load axis also improves. 
[0011] 

[Effect of the lnvention]As mentioned above, when the denominator polynomial showing the relation to position instruction 
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:a _ , ., lL , . , of an inverse transfer function is a constant according to this invention, 

mref[ of a control system / from output theta. ] 



axis and whose output theta! of a control system correspond, In an instruction generation part, at least primary is higher 

order than the degree of the numerator polynomial of said inverse transfer function in reference positional function 
theta |ref , And it sets up so that said reference positional function theta |ref which constitutes position instruction theta mref , 

and its differential coefficient may not have an absolute term, When the denominator polynomial of an inverse transfer 
function is the primary more than polynomial, in order to compute position instruction theta mref reference positional 

function theta |ref at the tip of a load axis of each axis and whose output theta ( of a control system correspond, By setting 

up said reference positional function theta^ in an instruction generation part higher order [ the 1st / at least / order ] than 

the degree of the numerator polynomial of an inverse transfer function, and forming the filter of the transfer function 



position instruction response and a desired position locus decreases as the result, improvement in the accuracy of 
position in a positioning control system can be aimed at. 



[Translation done.] 
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